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ABSTRACT 


Nanometer accuracy in many space applications requires that sensors be isolated 
from vibration disturbances by the main spacecraft body. The Flexible Spacecraft 
Simulator (FSS) at the Naval Postgraduate School is designed for testing multiple control 
system designs. The experimental setup simulates a microgravity environment for a 
flexible structure. A twenty-four state finite element model is used to characterize the 
flexible appendage. Piezoelectric ceramic wafers bonded to the structure are the actuators 
and sensors. A VisionServer external infrared camera provides direct feedback of the 
flexible structure’s elbow and tip displacements to sub-millimeter accuracy. A Multiple- 
Input-Multiple-Output (MIMO) Linear Quadratic Gaussian (LQG) controller is 
experimentally compared with a Positive Position Feedback/Velocity feedback controller. 
The damping is increased on the order of 825% for both control implementations. The 
objective is to minimize the disturbance of the tip of the flexible structure, representing the 
reflector support point. 
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I. INTRODUCTION 


The rapid advancement of space sensor technology and the requirement for 
nanometer accuracy has created a need for minimum vibration noise, high precision 
mounting platforms in space. The consumer’s demand for high resolution imagery, large 
space structures, and precise position and attitude determination has produced a large 
body of advanced research in the field of structural control. Concurrent to the rapid 
increase in accuracy and resolution of sensor payloads is the need to isolate payloads from 
the disturbances inherent to any spacecraft. 

For these types of applications, smart structures are a promising technology. In 
general, smart structures are the system elements that sense the dynamic state and change 
the system’s structural properties, such as its natural frequencies and damping, to meet 
given performance objectives. 

There are several types of embedded sensors and actuators which can be used for 
vibration and structural control. The embedded sensors are piezoelectric deformation 
sensors, strain gages, and fiber optic sensors. The embedded actuators are piezoceramic 
wafers, electrostrictive ceramic wafers, piezoceramic polymer film and shape memory 
metal wires. Piezoceramic sensors have a high strain sensitivity , a low noise baseline, low 
to moderate temperature sensitivity, and an ease of implementation. Piezoceramic 
actuators have high stiffness, sufficient stress to control vibration, good linearity, 
temperature insensitivity, are easy to implement, and minimize power consumption. 

Conventional control methods have worked well in the past, but new design 
methods are required to obtain improved performance and robustness characteristics from 
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the structural control system in order to satisfy future design specifications. Positive 
position feedback (PPF) and velocity feedback are two proven methods of structural 
control that work well with piezoceramic actuators and sensors. With a multiple-input- 
multiple-output (MIMO) control system, linear quadratic control methods are a preferred 
choice. 

Linear quadratic control is based on full state feedback. If all the states are not 
known, an observer is inserted into the loop to estimate the unknown states. Linear 
quadratic controllers using state estimate feedback are optimal for the nominal plant 
models but the performance may be far from satisfactory in real life due to plant 
uncertainties, unmodeled plant dynamics, and sensor noise that is unaccounted for in the 
system compensator. Attractive passband robustness properties of full state feedback 
optimal quadratic designs may disappear with the introduction of a state estimator. The 
Linear Quadratic Gaussian methodology provides an integrated frequency domain and 
state space approach for design of MIMO control systems. 

This work concerns experimental verification of a LQG controller design [Ref. 1], 
The design will be implemented on the NPS Flexible Spacecraft Simulator using two 
piezoceramic stack actuators and two piezoceramic sensors with an external optical 
infrared camera system to provide the feedback to the controller. 
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II. SCOPE OF THESIS 


The objective of this research is to damp out the vibrations of a flexible antenna 
support structure. The flexible spacecraft simulator (FSS) in the Spacecraft Dynamics and 
Control laboratory will be used to experimentally verify the data obtained from an 
analytical LQG model [Ref.l]. In addition, an external infrared optical sensor will be 
employed to provide structure position and velocity information to the optimal controller. 

The experimental procedure will be to first zero out the bias values of the sensors, 
execute the initial condition procedure, then test the various controller schemes. The use 
of multiple sensors and actuators will enable the controller to quickly dampen out higher 
order modes of the disturbance. The optimal controller will be compared against a known 
effective control scheme such as Positive Position Feedback (PPF) with derivative 
feedback control. 

The format for the work is laid out as follows. The Chapters III through V will 
provide the background and theory used to develop the LQG controller, namely optimal 
control theory, finite element analysis, and piezoelectric theory. Chapter VI will give a 
description of the VisionServer camera system followed by Chapter VII which will 
summarize the analytical model design from Reference 1. Chapter VIII will explain the 
experimental setup used for this thesis. Chapter IX will describe the experimental 
procedure and results, and Chapter X will present conclusions and recommendations. 







III. OPTIMAL CONTROL THEORY 

A. BACKGROUND 

State-space methods are the cornerstone of modem control theory. The essential 
difference between modem control theory and classical control theory is the 
characterization of a process by differential equations instead of transfer functions. In the 
modem approach, processes are represented by systems of coupled, first-order differential 
equations. In principle, there is no limit to the order of the system and in practice the limit 
is the computational cost to perform the required calculations reliably. 

B. STATE-SPACE REPRESENTATION 

Second-order differential equations can be expressed as a set of simultaneous first- 

order equations. They are represented in state-variable form as the vector equations 


x = f(x,u) 
y = h(x,u) 


(3.1) 


where the input is u, and the output is y. 

The column vector x is called the state of the system and contains n elements for a 
wth-order system. For mechanical systems, the states usually consist of the positions and 
velocities of the separate bodies. The vector function f relates the first derivative of the 
state to the state itself and the input u. Parameters in the function f could be dependent on 
time as well as position and velocity, but by and large, for structural systems the 
parameters can be considered time-invariant. Linear approximations will be used for 
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nonlinear systems in design and analysis. For the linear case, equation (3.1) can be written 


as 

x 

y 

where A is an nxn system matrix, B is an nxm control matrix, C is an Ixn observer matrix 
and D is an Ixtn feed-through matrix (direct transmission matrix). Under most 
circumstances D is normally a null matrix. 

C. TRANSFORMATION OF STATE 

The description of the system given by equation (3.2) is not unique. Matrix 

algebra enables a linear transformation of state without changing the basic properties of a 
matrix. Consider a state vector z where 

x = Tz (3.3) 

and T is a nonsingular matrix. Substituting equation (3.3) into equation (3.2a), a linear 
transformation of state is performed 


Ax + Bu 
Cx + Du 


(3.2a,b) 


* nr • a nr 

x = Tz = ATz + Bu 

z = T ’ATz + T ’Bu 
z = A t z + B t u 


where 


(3.4) 


A t = T ’AT 
B t = T 'B 
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Substituting equation (3.3) into equation (3.2b) 


where 


y = CTz + Du 
- C T z + Du 



= CT 


(3.5) 


It is sometimes convenient to transform a physical system model into its modal 
canonical form, also known as the Jordan canonical form. This state description 
decouples the coupled first order equations into n independent first-order equations, 
providing that the system matrix is diagonalizable. This description has many advantages. 
It allows the characterization of the degree of control authority the input has on each 
mode, the observability of each mode, and the damping ratio of each damped mode. 

D. OPTIMAL CONTROL THEORY 

An effective and widely used control technique of linear control systems is the 

optimal Linear Quadratic Regulator (LQR). Provided the full state vector is observable, 
this method can be employed to fit specific design and performance criteria. A quadratic 
cost function is used to minimize the performance index, J. The general form for the LQR 
is 


J = J (x r Qx -+u r Ru)rfr 


(3.6) 
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where Q is the state weighting matrix and R is the control weighting matrix. The 
necessary conditions for the optimal solution are that Q must be symmetric and positive 
semi-definite and R must be symmetric and positive definite. The solution to the LQR 
problem results in the optimum full state feedback gain matrix 

K = R-'B'M (3.7) 

where M satsfies the matrix Riccati equation 

- M = MA + ATM - MBR 'B'M + Q (3.8a) 


For a time-infinite solution, M is set to zero. The control input is then 

u = -Kx (3.8b) 

If the full state vector is not available it is necessary to design a state estimator or 
observer. The general form of an observer is given by 

x = Ax-f Bu + L(y-Cx) (3.9) 

where x is the estimated state vector and L is the observer gain matrix. The inputs to the 
observer are the outputs from the plant and the control inputs to the plant. 
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A 

By solving for the optimum observer gain, L , the observer is known as a Kalman 
filter. The general form of the dynamical equations used in Kalman filter synthesis are 

x = Ax + Bu + Fv 

n n ^ (3.10) 

y = Cx + Du + w 

where F is the plant uncertainty matrix, w is the state noise vector, and v is the sensor 
noise vector. Both v and w are considered to be white noise processes. White noise 
processes have the property of having a zero mean. This assumption does not always hold 
true in the real world but it simplifies the analysis considerably. The solution for the 

optimal observer gain is given by probability theory. The Kalman observer gain, L , is 
given by 

A A - 

L = PC'W 

A 

where P is taken from 

P = AP + PA' - PC'W CP + FVF' 

The process noise covariance matrices V and W are given by 

£{v(t)v'(0} = V(t)8(t-x) 

E{v(t)w'(t)} = X(t)8(t-x) (3.13) 

E{w(t)w'(t)} = W(f)8(/-x) 


(3.11) 


(3.12) 
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X(t) is the system cross-covariance matrix and is a function of the correlation of sensor 
noise to plant noise and under most circumstances is considered zero. The symbol E{ } 
denotes mathematical expectation, which is the average computed in the probabilistic 
sense. 

E. CONTROLLABILITY AND OBSERVABILITY 

Controllability indicates the extent that the states are controllable via the control 
matrix, B. Observability indicates the number of states that are observable via the sensors. 
They are two mutually independent functions of the system plant matrix, control matrix 
and the observer matrix. One simple test for controllability and observability is to form 
the controllability matrix (Me) and the observability matrix (Mo). If each matrix is of full 
rank the states are independent of one another and can be controlled or observed. The 
degree of controllability or observability cannot be determined from this test. Converting 
the system to Jordan canonical form, however, will help indicate the relative control 
authority to the individual modal states and also the relative observability for each modal 
state. An element with a value of zero indicates that it is detached from the controller or 
sensor and the larger the element’s absolute value the more controllable or observable a 
state is in relation to other modes. 

The following are the equations for the respective matrices: 


M c = [b AB A 2 B A" 'b] 

M„ = [C 7 A 7 C 7 (A 7 ) 2 C 7 (A r r~'C 7 f 


(3.14) 
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A complete treatment is given in several textbooks, such as [Refs. 2,3]. These 
concepts will play a fundamental role in the design of the control system for the flexible 
structure. The whole concept of control design is a compromise between accuracy, 
complexity, and robustness. In particular, as this thesis will show, a very accurate model 
of the system might not only be too complex, but also might be bound to be uncontrollable 
or unobservable. This is because an exact model is likely to contain a number of states, 
i.e. modes, which are hard to completely control with the given input signals. Likewise 
these same states might not be easily observable. When this is the case, the designer 
would look for a simpler model where all the states are controllable and observable, and 
the effect of the neglected states will be within the noise level. For this problem the 
controllability and observability matrices give a clear indication on the characteristics of 


the model. 




IV. PIEZOELECTRIC THEORY 


A. HISTORY OF PIEZOELECTRICITY 

Piezoelectricity is a phenomenon that describes certain materials that generate 

electricity when a mechanical stress is applied. This is known as the direct effect. 
Conversely, when an electric field is applied to them a mechanical stress is generated. 
Piezoelectricity occurs naturally in some crystalline materials and can be induced in other 
polycrystalline materials through a process known as “poling”. The material’s crystal 
lattice structure may be poled by the application of a large electric field, usually at high 
temperature (see Figure 4.1). [Ref. 4] 



Figure 4.1. [Ref. 4] Crystalline Lattice Structures 
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Subsequent application of an electric field will produce additive strains locally 
which translate into a global strain for the material. The direct piezoelectric effect has 
been used for a long time in sensors such as accelerometers. Use of the converse effect 
has been restricted to ultrasonic transducers until recently. Barium titanate, discovered in 
the 1940s, was the first widely used piezoceramic. Lead zirconate titanate (PZT), 
discovered in 1954 [Ref. 5], has now largely superseded barium titanate because of its 
stronger piezoelectric effects. Only recently have researchers in the area of structural 
control taken notice of the very desirable features of piezoelectric actuators and have 
started using them for many structural control applications. Piezoceramics are compact, 
have a very good frequency response, and can be easily incorporated into structural 
systems. Actuation strains on the order of 1000 pstrain have been reported for PZT 
material. Strains are non-dimensional ratios of the change in length to the original length 
for a given impetus. Within the linear range piezoceramics produce strains that are 
proportional to the applied electric field/voltage. These features make them very 
attractive for structural control applications. 

There are several methods to model the constitutive behavior of piezoelectric 
materials. The most popular is the macromechanical approach, it provides the relationship 
between the electrical and mechanical effects in a manner that can be incorporated into 
typical isotropic or orthotropic structural materials. For linear piezoelectric materials, the 
interaction between the electrical and mechanical variables can be described by linear 
relations of the form 
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S i = S ij Tj +d mi E m 

E m — d mi T, + £ mk E k 


(4.1) 


The mechanical variables are the stress T and the strain S, and the electrical variables are 
the electric field E and the electric displacement D; s is the compliance, d is the 
piezoelectric constant and e is the permittivity. The first equation describes the converse 
piezoelectric effect, and the second equation describes the direct effect. The stress and 
strain are second order tensors, while the electric field and electric displacement are first 


order. 


Figure 4.2 shows the typical coordinate system used to represent a poled 


piezoelectric. The 3-axis is in the direction of the initial polarization. 



Vindicates poling direction 


Figure 4.2. [Ref. 4] Typical Piezoceramic Coordinate System 


The 1 and 2-axes are arbitrary in the plane perpendicular to the poling direction. The 1 
and 2-axes are arbitrary because a poled piezoelectric is transversely isotropic in the 1-2 
plane. The equations above written explicitly in matrix form are 
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Where Si through S 3 are the normal strains, S 4 through S 6 are the shear strains, T| 
through T 3 are the normal stresses, T 4 through T 6 are the shear stresses, Dj through D 3 
are the electric displacements and Ei through E 3 are the electric fields associated with the 
given coordinate system. 

The piezoelectric constants that are of most interest from a structural standpoint 
are the d constants. These constants relate the strain developed in the material to the 
applied electric field; obviously, the highest value of these constants is desirable. The d 33 
constant relates the strain in the 3-direction to the field in the 3-direction.; similarly, the d 3i 
relates the strain in the 1-direction to the electric field in the 3-direction. The electric field 
is voltage applied across the piezoelectric divided by its thickness. It is important to point 
out that usually d 33 is positive and d 3i is negative. This means that a positive field (i.e., a 
field applied in the poling direction) will produce a positive mechanical strain in the 3- 
direction and a negative strain in the 1-direction. 

There are many applications for the use of PZT actuators and they can be divided 
into two general categories: linear actuators and actuators used for structural control 
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applications. In the first category, PZT actuators arranged in the form of stacks are used 
in a fashion similar to shakers or conventional hydraulic or electrical actuators. Due to the 
fact that the stroke is severely limited, in static applications they are used only for 
micropositioning work. In structural control applications, the actuators are typically 
embedded or bonded to the surfaces of the structure and apply localized strains that can be 
used directly to control structural deformations. A typical arrangement is shown in 
Figure 4.3; the two actuators are on the upper and lower surfaces of the structure and are 
actuated out of phase (the upper expands and the lower contracts), which creates a 
moment on the structure. [Ref. 4] 


top actuator expands 

^ indicates 



bottom actuator contracts 



Figure 4.3. [Ref. 4] Piezoceramic Actuator Pair 


In the remainder of this chapter we will apply piezoceramic actuators and sensors as 
structural control elements. 
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B. FLEXIBLE SPACECRAFT SIMULATOR PIEZOCERAMIC 
ACTUATORS AND SENSORS 

Piezoceramic sensors and actuators are located on the flexible appendage as shown 
in Figure 4.4. The piezoceramic wafers are bonded to the surface of the flexible arm and 
the voltage developed from the sensors is fed to the actuators by way of the designed 
control system. 



Figure 4.4. Piezoceramic Actuators and Sensors Mounted on the FSS Flexible Beam 

Figure 4.5 illustrates the orientation of a piezoceramic wafer on an arm and the alignment 
of its axis that describes the electro-mechanical relationships. 



Figure 4.5. Poled Piezoceramic Mounted on FSS Beam 
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The piezoceramic wafers in a sensory mode produce a charge between their 


electrodes that is directly proportional to the lateral strains. It is given by 

Q=AEd il ( e,+e 2 ) (4.3) 


where A is the lateral area of the piezoceramic wafer, E is Young’s modulus of the wafer, 
d 3 i is the lateral charge coefficient, and £/ and e 2 are the strain values in the lateral 
directions respectively. The capacitance for a piezoceramic wafer as shown in Figure 4.5 
is given by 



(4.4) 


where D is the dielectric constant of the piezoceramic and t is the thickness of the wafer. 
The voltage V produced by a sensor under strain is given by 

Q Ed „ 

V = ^ = -^-t(e,+E 2 ) (4.5) 

When using piezoceramic wafers as actuators, the attachment geometry is similar to the 
sensor geometry shown in Figure 4.5. The control voltage , e c , is applied to the wafers 
and the lateral strain that is developed can act to control the bending of the beam. The 
electric field that is developed by the wafer is given by 




(4.6) 



Care must be taken not to induce a strong electric field that is opposed to the 
piezoceramic’s poling direction as that can damage the material by depolarizing it. Typical 
field limits by most materials are between 500 and 1000 volts/mm. 
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V. FINITE ELEMENT ANALYSIS 

A. BACKGROUND 

The need for characterization of complex structures and the advent of the modem 
day computer has given rise to a method of analysis known as the finite element method. 
The idea behind the finite element method is to provide a formulation which can exploit 
digital computer automation for the analysis of irregular systems. To this end, the method 
regards a complex structure as an assemblage of finite elements, each of which is part of a 
continuous structural member. By requiring that displacements be compatible and internal 
forces be balanced at points shared by elements, known as nodes, the entire structure is 
compelled to act as one entity. 

The finite element method of analysis, while considering a continuous structure, is 
a discretization problem. It expresses the displacements of the continuous structure in 
terms of a finite number of displacements at the nodal points multiplied by interpolation 
functions. The advantage of the finite element method over any other method is that 
system equations can be derived by first deriving the equations for a single element and 
then assembling them by using constraint conditions. The displacement at any point inside 
the element is obtained by means of interpolation, where the interpolation functions are 
generally low-degree polynomials and are identical for every element. [Ref. 6] 

B. ELEMENT STIFFNESS MATRIX 

Meirovitch [Ref. 6, pp. 303-304] uses the direct method for derivation of the 

elemental stiffness matrix. The stiffness matrix relates a displacement vector to a force 
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vector. Using the element in Figure 5.1, for uniform bending stiffness, the differential 
equation for the displacement w(x) is 

d*w(x) 

El ———— = 0 0 <x<h (5-1) 

CiA' 

where E is Young’s modulus for the material and I is the area moment of inertia for the 
beam cross-section. 



Figure 5.1. Beam Element for Finite Element Model 


By integrating four times, we have the elemental displacement at any point 

w O)=s c i* 3 + 2 c 2 x 2 +c 3 x + c 4 (5.2) 

with cj through c 4 as the constants of integration, determined from the boundary 
conditions 
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w(0) = w, 


dw(x) 


dx 


x=0 



w(h) = w 2 


dw(x) 


dx 


X-h 



(5.3) 


Wi and w 2 are the nodal displacements and 9\ and are the nodal rotations at the 
endpoints of the element. By solving equation (5.2) into (5.3) the corresponding 
constants of integration are solved as 


Cj — (2Wj + hOy 2 w 2 + hS^ 
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Hence, introducing equation (5.4) into (5.2), the expression for the bending displacement 
is determined to be 
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The bending displacement is related to the inter-element nodal forces //, /?, and f 4 as 

follows 
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Combining equations (5.6) and (5.5) yields 
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This can be written in matrix form as 
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where the nodal displacement vector and the nodal force vector are given by 
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and the element stiffness matrix is given by 


(5.9) 
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C. ELEMENT MASS MATRIX 


(5.10) 


Equation (5.5) can be written as a function of the nodal displacements and 
interpolation functions, L(x) 
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w(x) = L l (x)w 1 + L 2 (x)h0 l + L 3 (x)w 2 + L 4 (x)h0 2 


(5.11) 


where 
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Equations (5.11) and (5.12) can be expressed in matrix form 

W (x,0 = {i(x)} r {x(0} (5.13) 


with {L(x)} as a four-dimensional vector of the interpolation functions and {x(t)} a four¬ 
dimensional vector of nodal displacements. The element kinetic energy has the form 
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where the 4x4 mass matrix is given by 


M = J 0 m(x){l(x)}{Z(x)} r c6c 


(5.15) 


Inserting the interpolation functions vector, equation (5.12), into equation (5.15) 


and integrating over the element length, the elemental mass matrix becomes 
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D. ASSEMBLING THE GLOBAL MASS AND STIFFNESS MATRICES 
INTO THE COMPLETE SYSTEM 

The next step is to assemble each element’s mass and stiffness matrices into the 
global system mass matrix and the global system stiffness matrix, respectively. The 
assembling procedure is an algebraic process of summing the overlapping element 
matrices. Consider the 4x4 element matrix partitioned into a 2x2 matrix of 2x2 sub¬ 
matrices 
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The global system matrix is required to be symmetric and is constructed by adding the 
element matrices along the diagonal 
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For example, with three elements this matrix becomes 
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The method is the same for both the stiffness and the mass matrices. In order to 


satisfy the boundary conditions for a fixed-free system, the displacement and rotation at 
the root of the flexible appendage must be zero. This condition is satisfied by eliminating 
the first and second rows and the first and second columns from both the global mass and 
stiffness matrices, respectively. 

E. PIEZOELECTRIC FINITE ELEMENT MODELING 

The piezoceramic elements used in the structure must be incorporated into the 

finite element model. The basic equations for both piezoceramic actuators and sensors are 
the same as for ordinary structural elements discussed in the previous section. There is a 
need to compensate for the piezoceramic displacement from the center of the beam and 
Figure 5.2 illustrates this concept. In addition, the electro-mechanical relationships must 
be taken into account for implementation into an analytical model suitable for control 
design. 



Figure 5.2. Piezoceramic Element Placement on Beam 


From equation (4.1) the general relationship for the electro-mechanical coupling is 
given by 
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Using the fact that the elastic constant for piezoceramic material, s , is the inverse of its 
Young’s modulus, E p , this equation can be written as 
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(5.21) 


The next step is to set up the equation for the elemental potential energy, U. 


-U = U(-T l S l +D,E,)dV 


(5.22) 


where the two terms in the integral represent mechanical energy (TiSi) and electrical 
energy (D 3 E 3 ). Using w p as the width of the piezoceramic wafer, this equation can be 
rewritten as 
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The strain, Si, can be written using small angle displacement theory as 
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(5.24) 
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substituting equation (5.21) into equation (5.23) 
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then, using equation (5.24) 
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Rewriting equation (5.13) in terms of a summation 


w(x, 0 = £ ® < ( x )<li (0 (5 .27) 

J=1 

where O is the vector of interpolation functions or “modeshapes” and q is the nodal vector 
from equation (5.9a). Inserting this equation along with the interpolation functions, 
equation (5.12), the general form of the energy equation is 
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Substituting the interpolation functions from equation (5.12) into the b vector, we get 
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and into the piezoceramic elemental stiffness matrix, [k„] 


(5.30) 
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The piezoceramic elemental mass matrix is derived in the same fashion as an 
ordinary structural element with the exception that the piezoceramic material linear mass 
density be used instead of the ordinary material density of the structure to which it is 


bonded. 

For structural elements that have piezoceramic material bonded to them, their 
respective mass and stiffness matrices are given by the simple addition of the beam 
elemental matrices and the piezoceramic elemental matrices which are then assembled into 
global mass and stiffness matrices as in the previous section. 
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VI. VISIONSERVER CAMERA SYSTEM 


The VisionServer camera system is a complete hardware and software system 
designed to meet vision system needs such as real-time control applications. The system 
locates and tracks passive or active targets and outputs selected data via a digital-to- 
analog converter and network interface. 

Groups of targets can be identified and tracked as individual objects or as bodies. 
Three targets make up a body and the VisionServer can output a body’s x,y, and 0 values 
in addition to their rates of change. For a point target, a single LED is used and the 
system can output x and y translational data only. 

The VisionServer system is capable of high-speed planer position and orientation 

til 

measurement of multiple moving objects with sub-pixel resolution on the order of 1/20 of 
a pixel, which for this setup translates to 0.5 mm accuracy. Under optimal conditions, 
with an accurate calibration, the system can provide accuracy down to 0.1 mm. The 
system is also capable of satisfying both real-time modules ( VxWorks ) and supervisory 
modules (UNIX) concurrently. Some of the basic features include: 

• 60 Hz sampling rate for real-time tracking of multiple objects 

• Very high resolution (4000:1 or better) 

• Optional velocity estimates for all objects 

The VisionServer hardware consists of a Pulnix TM-440X (CCIR) charged 
coupled device (CCD) as the sensor, a dedicated Motorola MC68030 microprocessor as 
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the target architecture, and a Sun SPARC-20 workstation as the host/supervisor 
architecture. 

The CCD camera has an 8mm lens whose viewing angle is approximately 38 
degrees and connects directly to the target machine. The camera is capable of sensing 
either infrared LEDs or reflective tape with spot lighting. The camera must be calibrated 
for the specific type of light source in order to maintain sub-pixel resolution. The 
performance tradeoff for the CCD is its height above the plane on which it is measuring 

the moving objects. As the distance increases, coverage area increases but resolution 
decreases. 

The target architecture is a Heurikon V3D VME-based processor board that has a 
dedicated Motorola MC68030 microprocessor onboard. The operating system is 
VxWorks , a real-time application-specific operating system. The system processes the 
digital data from the CCD and converts the signal to a twelve-bit value. The value is then 
sent to the Xylog XVME-505 16-channel digital-to-analog (D/A) converter card where it 
is quantized and output as a voltage to the AC-100 analog-to-digital (A/D) converter. 
The output voltage from the D/A card is limited to ±10 volts. The sampling rate is fixed 
at 60 Hz which limits the experimental sampling rate to 30 Hz to avoid aliasing problems. 

The host architecture is a Sun SPARC-20 workstation operating SunOS 4.1.3 
(UNIX) as its operating system. The host machine contains all the required files and 
executable code for the target processor, and is connected to the target processor via an 
internet network adapter card. The host machine also contains two supervisory programs 
to allow user interface with the VisionServer camera system: StethoScope, a real-time 


34 



graphical monitoring and data collection utility, and ControlShell, an object-oriented 
framework for the real-time system software. 

StethoScope is a real-time graphical monitoring and analysis tool that runs in the 
Sun OpenWindows environment. It allows examination and analysis of the real-time 
application while it is running. Tts powerful multi-window environment enables the user 
to select specific variables to observe and collect. The data collection utility allows the 
user to interface with Matlab or MATRIXx and save collected samples in either format. 

The ControlShell provides a series of execution and data interchange mechanisms 
that form a framework for building real-time applications. The shell is the primary user 
interface with the VisionServer system. It allows configuration and calibration of the 
VisionServer system software to fit the user’s needs. Appendix A contains files necessary 
to configure the VisionServer system. Figure 6.1 shows the block diagram for the 
hardware setup used for the experimental portion of this thesis. 



Figure 6.1. VisionServer Experimental Setup 
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VII. ANALYTICAL MODEL 

A. FINITE ELEMENT MODEL 

The flexible appendage is modeled using the finite element method (FEM). 
Initially, a twelve element model was used to characterize the system. The twelve element 
model experienced controllability and observability problems and the order of the model 
was reduced to a six element model. This process is explained in detail in Chapter III, 
Section E. The theory in Chapter V is used to create the model shown in Figure 7.1. 
Elements 1 and 4 are the piezoceramic actuator elements, elements 2 and 5 are the 
piezoceramic sensor elements, and the VisionServer tracks the Elbow and Tip, both 
containing three infrared LEDs, respectively. 



Figure 7.1. Finite Element Model of the FSS Flexible Appendage 
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Incorporating the piezoelectric theory from Chapter IV into the finite element 
model, the system state-space matrices (A,B,C, and D) were determined [Ref.l]. 
Appendix B contains the Matlab program (fem.m) used to characterize the system along 
with the respective system matrices. Table 7.1 gives the material properties and 
parameters for the finite element model used. 


7075 T-6 Aluminum Beam 

Quantity 

Description 

Units 

Value 

tb 

Beam thickness 

meters 

1.5875xl0- 3 

Wb 

Beam width 

meters 

0.0254 

Pb 

Beam density 

kg/m 3 

2800 

Eb 

Young’s Modulus 

N/m 2 

1.029xl0 7 

Navy Tvne II PZT 

Quantity 

Description 

Units 

Value 

d 31 

Lateral strain coefficient 

m/V or Coul/N 

1.8x10'° 

E P 

Young’s Modulus 

N/m 2 

6.3x10'° 

V 

Poisson’s ratio 

N/A 

0.35 

D 

Absolute permittivity 

Farad/m or N/V 2 

1.5x1 O' 8 


Table 7.1. Model material properties 


Using the material properties from Table 7.1 the finite element model produced 
twelve natural modes of vibration. Table 7.2 gives the values for the natural frequencies 
and Figures 7.2 and 7.3 give the modeshapes for the first two modes. These two modes 
are the primary carriers of energy for the structure and it is they that the compensator will 
be designed to actively control. Appendix C contains the complete set of modeshapes as 
determined by the finite element model. 
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0.8707 


11.108 


28.496 


45.144 


102.78 


278.83 


341.04 


1347.7 


1392.7 


5284.5 


5343.0 


Table 7.2. Finite Element Model Natural Frequencies 


The number of frequencies and modeshapes generally considered accurate from a 
finite element model is equal to half the number of elements used. In this case, six 
elements are used and thus the first three modes are considered sufficiently accurate. 
Using an elementary experimental modal procedure, the first three modes of vibration 
were determined to be 0.288 Hz , 0.877 Hz, and 9.82 Hz, respectively. This indicates 
percentage errors for the first three modes of 2.7%, 0.72%, and 13.1 % each. 

Since we are concerned with only the first two modes, this model should suffice 


for the design of the experimental controller. 
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Figure 7.2. Modeshape for first mode Figure 7.3. Modeshape for second mode 

B. SIMULATION RESULTS 

The general state-space equations for this system are 


x = Ax + Bu + Fvv 
y = Cx + v 


(7.1) 


The system matrix, A, is a high fidelity twenty-four state model with incorporated 
structural damping approximating the actual FSS flexible arm assembly. The control 
matrix, B, based on equation (5.29) has two independent actuators and is a 24x2 matrix. 
The sensor matrix, C, is a 6x24 matrix that contains two piezoceramic sensor outputs and 
four outputs from an optical infrared VisionServer camera system. The piezoceramic 
outputs are governed by equation (5.29). The VisionServer measures the displacements 
and rotations of the elbow and tip assemblies individually and outputs those four states 
directly. 

The values of Q y , the output weighting matrix, and R, the control weighting 
matrix, were determined from simulation [Ref. 1] as 
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0 
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0 0 0 0 

100 0 0 0 
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0 0 1 0 

0 0 0 9000 

0 0 0 0 


0 

0 

0 

0 

0 

900000 



0 

0.1 


(7.2) 


where the sensor output vector, y, contains the piezoceramic sensors as the first two 
elements (volts) and four VisionServer outputs (elbow displacement, elbow rotation, tip 
displacement, and tip rotation) as the last four elements (meters and radians, respectively) 
of the output vector. The two control inputs (volts) are the base actuator and the elbow 
actuator, respectively. 

These values kept the control inputs within their limitations of ±150 volts, the 
sensors within their limitations of ±10 volts, minimized the steady state error, and met a 20 
second settling time constraint. Figure 7.4 illustrates the simulation results for a typical tip 
rotational displacement in the time domain, it is representative of all simulation sensor data 
observed. The upper graph is the open-loop response to a disturbance and the bottom is 
the LQR controller response to the same disturbance. 
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Open Loop Response to Initial Condition 



For the Kalman filter design, the plant uncertainty matrix, F, is the identity matrix 
and the model uncertainty (W) is approximated at 5%. The sensor process-noise is taken 
as the squares of component rms noise values (V matrix diagonal elements) from 
documentation and previous research. 


W = 0 . 05 [ I ] 


0.0001 

0 

0 

0 

0 

0 

0 

0.0001 

0 

0 

0 

0 

0 

0 

0.00025 

0 

0 

0 

0 

0 

0 

0.002 

0 

0 

0 

0 

0 

0 

0.00025 

0 

0 

0 

0 

0 

0 

0.001 


(7.3) 
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A method for determining the performance of the LQG controller is to measure the 
damping effectiveness for the system. One method for determining the damping from data 
is the Log Decrement method given by 



1 

2 nn 


A 

ln(—*-) 


(7.4) 


with £ being the damping ratio, n the number of cycles between measurements, A-, and A { 
the initial and final amplitudes, respectively. In order to determine damping, we need to 
excite one mode at a time. In general, we were able to excite independently only the first 
two modes. The damping coefficients for the first two modes were determined by 
simulated excitation of those modes. The results using the log decrement method were 
12% [Ref. 1]. Recalling the original damping ratio of 0.4% an increase in damping on 
the order of 29 times or 2,900% was obtained. 

This model was discretized using a Tustin transformation and the values of the 
system matrices were inserted into the System Build digital controller design on the 
VAXstation. The next chapter describes the experimental setup followed by the 
experimental analysis. 
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VIII. EXPERIMENTAL SETUP 


A. OVERVIEW 

The Spacecraft Dynamics and Control Laboratory Flexible Spacecraft Simulator 
(FSS) simulates attitude motion about the pitch axis of a spacecraft. As shown in Figures 
8.1 and 8.2 it consists of a single degree-of-freedom rigid central body, representing the 
spacecraft central body, and a multiple degree-of-freedom flexible appendage, representing 
an antenna reflector with a flexible support structure. 



Figure 8.1. NPS Flexible Spacecraft Simulator (FSS) 
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Figure 8.2. NPS FSS Flexible Arm Assembly 


Piezoceramic sensors and actuators are used to provide active damping to the 
flexible support structure. The flexible appendage has two stacked piezoceramic pairs as 
sensor/actuators. The first pair is located at the base of the arm assembly as shown in 
Figure 8.3 and the second is located at the base of the forearm near the structure’s elbow 
as in Figure 8.4. 



Figure 8.3. Base Sensor/Actuator Pair 






Figure 8.4. Elbow Sensor/Actuator Pair 


An overhead infrared camera system is used as a sensor to track designated targets 
and output their values to the AC-100 real-time control system. Figure 8.5 shows the 
camera mount for the VisionServer system. 



Figure 8.5. VisionServer Camera (CCD) 









The VisionServer tracks two groups of three LEDs mounted on the Elbow and 
Tip. Figures 8.6 and 8.7 are descriptive of the LED layout for the Elbow and Tip bodies. 



Figure 8.6. Elbow LED Layout Figure 8.7. Tip LED Layout 

The entire system is floated on air pads over a finely ground granite table to 
simulate a microgravity environment. The central body has two thrusters and a 
momentum wheel as its actuators. For this experimental verification of a LQG controller, 
the main body will be fixed to the table and the flexible appendage will be floated and 
allowed to vibrate freely, and there will be no mass intensifiers on the structure. All 
disturbances will be created by the software controller in System Build. Figure 8.8 gives 
an overall view of the VAXstation 3100 and the AC-100 Real-Time Controller. 
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Figure 8.8. Control Workstation Setup for FSS Experiment 

B. AC-100 REAL-TIME CONTROLLER SETUP 

The AC-100 real-time controller is manufactured by Integrated Systems, Inc. It 

consists of a host machine and the real-time control processor. The host machine is a 
VAXstation 3100 that is connected via an internet adapter to the real-time control 
processor, an Intel 80386 microprocessor. Figure 6.1 shows the block diagram of the 
hardware connectivity for this experiment. 

The AC-100 processor is connected to the experimental apparatus via two A/D 
converters for the sensor inputs and one D/A converter for the actuator outputs. All D/A 
and A/D devices are limited to ±10 volts as inputs and outputs. 

The first A/D receives data from the two piezoceramic sensors mounted on each 
beam of the flexible arm structure. The connections are single-ended connections due to 
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restrictions on hardware functionality. This condition will introduce noise into the system 
and must be accounted for in the Kalman estimator. 

The second A/D card has the VisionServer inputs, namely the elbow’s 
displacement and rotation, and the tip’s displacement and rotation from their respective 
rest positions. These inputs are also single-ended connections. 

The one D/A card connects the digital controller to the two stacked piezoceramic 
actuators on the structure through a high voltage charge amplifier unit with a calibrated 
gain of -15. The output signals from the D/A card are limited to ±10 volts which 

correspond to a charge amplifier output of ±150 volts. This voltage is sufficient to actuate 
the piezoceramics without running the danger of de-poling them. 

The digital control system was implemented using MATRIXx, its graphical design 
tool System Build, and the AC-100 control software Real-Time Monitor (RTMONIT). A 
block diagram of the complete LQG control system is given in Figure 8.9. 
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Figure 8.9. System Build Block Diagram For Experimental Controller Verification 
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The System Build block diagram is transformed to a real-time file (RTF) format, 
compiled and linked by the C-compiler then uploaded to the AC-100 processor for 
execution. 

C. VISIONSERVER SETUP 

The CCD video camera is mounted 1.9 meters above the granite table assembly. It 
is connected to the 68030 microprocessor running a real-time operating system, VxWorks. 
The twelve bit digital data obtained by the camera is ported out of the 68030 via a digital- 
to-analog converter card at 60 Hz sampling frequency. The camera’s resolution is 
nominally at the sub-pixel level on the order of l/20 th of a pixel which leads to a camera 
accuracy of approximately 0.5 mm. 

The VisionServer system was calibrated using standard remote control LEDs. The 
LEDs used for the experiment are much more efficient and have better luminance 
properties. Thus, the system is not optimally calibrated resulting in a lower accuracy of 
0.5 mm instead of the advertised 0.1 mm that the system can produce with an optimal 
calibration. 

The major drawback with the experimental setup is the fact that the signal must 
travel out of the HK V3D board through the D/A converter along a fifteen foot single- 
ended cable through an A/D converter into the real time controller, the AC-100. Neither 
of the converter cards have pre-aliasing filters, thus a fair amount of noise is present in the 
signal. This fact was taken into account when designing the optimal Kalman observer. 

The arm structure has nine LEDs mounted in triplets at the base, elbow, and tip of 
the flexible structure. Three LEDs make up a body and the VisionServer can output a 



body’s x,y, and 0 values in addition to their rates of change. For a point target, a single 
LED is used and the system can output x and y translational data only. 

For this experiment, the base, elbow, and tip are the three bodies used by the 
VisionServer system. Translational and rotational data for each body is output to the AC- 
100 via the D/A - A/D link. The information necessary for this experiment applies to the 
elbow and tip of the structure as the base is fixed to the table. Appendix A has the 
software files necessary to configure the system for this experiment. 
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IX. EXPERIMENTAL PROCEDURE AND RESULTS 


A. BIAS REMOVAL AND COORDINATE TRANSFORMATION 

The first part of the experimental procedure is to remove the bias from all sensor 

inputs and perform a coordinate transformation from the global table coordinate system to 
the local arm coordinate system. 

Bias removal is performed by taking a fifteen second running average of each 
sensor input and latching the mean value. The mean value is then subtracted out in all 
subsequent calculations during experimentation. Figures 9.1 and 9.2 are the System Build 
block diagrams for this procedure. 

The next step is to perform a coordinate transformation from global coordinates to 
local coordinates. The VisionServer camera system measures all objects in the global 
frame of reference. In order to transform the global coordinates to local coordinates the 
rotation angle must be determined. The angle is taken as the latched value of each body s 
rotational bias from the measure_bias block. This rotates the coordinate system to align 
with the arm’s initial coordinate system and the experiment then begins from rest values. 

The combination of both of these processes enables each experimental run to start 
from zero, which in turn keeps the outputs for the VisionServer within the required ±10 
volts and enables the measurement of small displacements and rotations to be lifted above 
the noise floor. 







































B. FILTERING 


Following the coordinate transformation, the signals are passed through a second- 
order low pass filter (LPF) to eliminate noise and high frequency components. The value 
for the cutoff frequency was determined to be 2 Hz. Any higher cutoff frequency resulted 
in large amounts of noise getting into the system. The discrete second-order infinite 
impulse response filter (HR) state-space equation is given as follows 



Yn = [3.823 


0.163 



+ [0.004] Xn 


(9.1) 


with Xn being the input and Yn being the output of the discrete filter. Using a second- 
order low-pass filter minimized the associated time delay that accompanies such devices. 
Since the maximum frequency we are interested in is 0.87 Hz, the time delay is negligible 
as compared to the sampling frequency of 100 Hz. 


C. INITIAL CONDITION RESPONSE 

The initial condition is created by the piezoceramic actuators themselves. The 

actuators are excited for two types of responses, single-mode and multiple-mode 
responses. Figure 9.3 illustrates the experimental setup for the initial condition block. 
The two frequencies used are the first and second harmonic frequencies. The logic blocks 
enable the initial condition input for a ten second period between bias removal and the 
controller actuation. 
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Discrete Super-Block Sampling Interval First Sample Ext.Inputs Ext.Outputs Enable 
Initial Conditions 0.0100 0. 2 3 Parent 



Figure 9.3. Initial Condition Control Block Diagram 
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DBLX(u) 




The main desire for the initial condition system is reproducibility. Figure 9.4 is a 


illustration of two test runs plotted on top of each other. The error between the two 
subsequent open-loop tests is experimentally determined to be 2.7%. The absolute value 
of the difference between the two runs was determined and then averaged to give the 
nominal error. 



Figure 9.4. Reproducibility Error Test 


D. ESTIMATOR VERIFICATION 

Next, we must verify that the estimator derived from [Ref. 1] is effective in the 

real-time implementation. The system is excited as per the initial condition block and then 
the outputs are compared. Providing the states are being estimated properly, this would 
indicate that the LQG controller should be effective. Once the estimator is verified the 
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Displacement (cm) 


next phase is the controller testing phase. Figures 9.5 and 9.6 show the filtered sensor 
outputs, tip displacement and rotation, from the VisionServer sensor plotted with their 


estimated values. 


Tip Displacement and Estimate 



Figure 9.5. Tip Displacement (-) and Estimate (.) 
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Tip Rotation and Estimate 



Figure 9.6. Tip Rotation (-) and Estimate (.) 


From the plots it can be seen that the estimator not only estimates the states well, 
but smoothes out the response as well. 

E. CONTROLLER TESTING AND EVALUATION 

There are two control types to be tested and compared: the LQG controller from 

[Ref. 1 ] and a Positive Position Feedback (PPF) coupled with velocity feedback. 

One of the first methods employed to damp the flexible appendage is positive 
position feedback (PPF). In order to implement this control law on the FSS, it is modeled 
as a second order system: 
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(9.2) 


e a +2^(O a e a +(O a 2 e a =-© a 2 ke s 

e a is the actuator applied voltage 
e s s the sensor sensed voltage 
^ is the actuator damping ratio 
co u is the actuator frequency 
k is the actuator gain 

By setting the actuator frequency equal to the structure fundamental frequency, a 
90° phase shift is attained in the region where CO a /CD = 1 . Figure 9.7 illustrates that 

the effect of this type of compensation is an active damping region in the area of 
co^ /(o nl =1 with active stiffness for frequencies above this region and active flexibility in 
the frequencies below this region. Thus it is important to set the actuator frequency at the 
fundamental structural frequency to avoid an increase in flexible mode strength for lower 
frequencies. 



Figure 9.7. Positive Position Feedback Control Theory 
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Since the PPF controller is effective only for the controller frequency, it is useful to 
augment PPF with another form of feedback control. Velocity, or derivative, feedback is 
a simple and effective form of feedback control. The use of velocity feedback increases 
the effectiveness of the PPF controller by adding damping for all frequencies. 

«. = M, (9-3) 

Figures 9.8 and 9.9 are the experimental results from testing the PPF/Velocity 
controller using the piezoceramic sensors as the source for the actuator. The targeted 
mode is the fundamental frequency, 0.288 Hz. The PPF gain is 4 and the Velocity gain is 
0.4. 


Tip Displacement with PPF/Vel Control (1st Mode) 



Figure 9.8. PPF Control for Single-Mode Response, Tip Displacement 

Damped (-) and Undamped (.) 
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Elbow Displacement with PPF/Vel Control (1st Mode) 




Figure 9.9. PPF Control for Single-Mode Response, Elbow Displacement 

Damped (-) and Undamped (.) 

It is evident that the response is well damped, yet the actuators have only low control 
authority over the fundamental mode which results in an increased settling time for the 
system. 

Figures 9.10 and 9.11, show the PPF/Velocity response to a multi-mode 
disturbance, the targeted modes are the fundamental and second harmonic, 0.917 Hz. The 
actuators damp out the higher modes quickly but again are limited in control authority 
over the fundamental mode, the gains are the same as those in the single mode. 
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Tip Displacement with PPF/Vel Control (Multimode) 



Figure 9.10 PPF Control for Multi-Mode Response, Tip Displacement 

Damped (-) and Undamped (.) 


Tip Rotation with PPFA/el Control (Multimode) 



Figure 9.11 PPF Control for Multi-Mode Response, Tip Rotation 
Damped (-) and Undamped (.) 
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Next, it is desirable to compare the piezoceramic sensors performance with the 
VisionServer camera system performance. The two displacement inputs (tip and elbow) 
are connected to the PPF/Velocity feedback controller and Figures 9.12 and 9.13 show the 
result. 


Elbow Displacement with PPF/Vel Control (VisionServer Only) 



Figure 9.12. PPF Control for Single-Mode Response, VisionServer Input Only 

Damped (-) and Undamped (.) 
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Tip Displacement with PPF/Vel Control (VisionServer Only) 



Figure 9.13. Tip PPF Control for Multi-Mode Response, VisionServer Input Only 

Damped (-) and Undamped (.) 


The control with the VisionServer inputs is not as robust as that with the 
piezoceramic sensor inputs. This is due to the fact that the raw VisionServer inputs are 
very noisy and after filtering, lose some of their gain. This leads to smaller inputs from the 
sensors thus less control authority. 

The final procedure will be to test the LQG controller and compare the results with 
the PPF/Velocity Feedback values. The LQG controller is designed for all the sensors 
inputs to be available for processing. The LQG controller can be expected to be more 
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sensitive to parameter variations since the assumptions, such as Gaussian noise, in its 
design [Ref. 1] do not hold true in real-time. The results given by the estimator indicate 
that the controller should work, but might not be as robust as designed. Figures 9.14 and 
9.15 show responses to the LQG controller. 


Tip Displacement with LQG Controller (1st Mode) 



0 2 4 6 8 10 12 14 16 18 20 


time (seconds) 

Figure 9.14. LQG Control for Single-Mode Response, Tip Displacement 

Damped (-) and Undamped (.) 
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LQG Tip Displacement for Single-mode Disturbance 



Figure 9.15. LQG Control for Multi-Mode Response, Tip Displacement 

Damped (-) and Undamped (.) 

As indicated, the response is satisfactory, but not optimal. The PPF/Velocity 
controller is comparable if not better in single-mode disturbance rejection. The LQG 
controller is still an effective control scheme, but more so in multi-mode control scheme. 
The LQG controller can be better optimized using advanced design techniques such as 
Loop Transfer Recovery to recover lost robustness and attempt to regain as much control 
authority as possible. 
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F. 


DAMPING SUMMARY 


Table 9.1 shows the damping ratios as determined by the log decrement method 
(Eqn. 7.4) from the experimental results. These results indicate a significant increase in 
damping by both control schemes with the PPF/Velocity behaving slightly better than the 
LQG controller. Employing Loop Transfer Recovery might add to the performance of the 
optimal controller. 



No Control 

LQG 

PPF/Velocity 

Fundamental mode 

0.004 

0.0367 

0.0387 

Second mode 

0.004 

0.0678 

0.0701 


Table 9.1. Damping Ratios for LQG and PPF/Velocitv Feedback Control 


















X. CONCLUSIONS AND RECOMMENDATIONS 


A. SUMMARY 

This thesis presents the experimental verification of an optimal controller for a 
flexible structure model and experiment using Linear Quadratic Gaussian techniques with 
piezoceramic actuators and sensors and an optical VisionServer camera sensor system. 
The LQG design was an effective controller for the flexible structure as was the 
PPF/Velocity feedback controller. Both systems required a low pass filter in the loop to 
reject high frequency noise. 

B. CONCLUSIONS 

The LQG controller design from [Ref. 1] was implemented and compared with a 
PPF/Velocity feedback controller. The LQG controller met design specifications but was 
not as robust as the simulation results predicted [Ref. 1]. The PPF/Velocity controller 
was very effective with single-mode disturbance rejection and showed limited capability 
for multi-mode excitations. The LQG controller was effective in damping all excitations 
but not as effective as the PPF/Velocity controller with single-mode control. The 
response of the system is limited by the fact that the actuators have low control authority. 
This is a factor in all controller implementations. 

The state estimator is an addition to the system, it performs satisfactorily in 
estimating the states, and it smoothes out the VisionServer inputs. 

The VisionServer is connected to the controller through two unfiltered digital- 
analog devices which leads to an extraordinary amount of noise. The raw data input from 
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the VisionServer system is unusable for control applications without a filter or estimator in 
the loop. The single-ended connections add to the noise problem, a differential connection 
scheme would minimize noise input to the system through common-mode rejection. 

In the simulation results, the damping was increased to 12% [Ref. 1], for the 
experimental results damping was determined to be on the order of 4% for the 
fundamental mode, and 7% for the second mode. The differences in the results can be 
attributed to the estimator performance in real-time. 

C. RECOMMENDATIONS 

For the controller, the next step is to optimize the LQG design by using advanced 
design techniques such as Loop Transfer Recovery and [i-analysis to maximize the 
robustness. Optimal FL control techniques may also prove advantageous for this type of 
structural control application. 

For spacecraft implementation, it is desirable to float the entire FSS and observe 
the interaction between the attitude controller and the flexible structure controller during 
slew maneuvering. Isolating the appendage tip from inherent spacecraft vibrations is an 
area of great interest and is a good follow-on to this work as well. 

The VisionServer system needs to be connected to the controller by differential 
connections in order to minimize the noise introduced into the system. The VisionServer 
system software can be modified to measure in local coordinates rather than the global 
coordinates and thus give a greater dynamic range to the sensor. 
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APPENDIX A 


VISIONSERVER SETUP AND SOFTWARE 

The setup for the VisionServer system is as follows: 

1. Ensure the Internet cables are connected between the target machine (wfft) and the 
host machine (voyager). Also ensure the serial connection between the two are 
connected in case that venue is to be used. 

2. Turn on wfft, this should suffice and the system should come up and boot 
automatically. If there is a problem, check that wfft has rsh (remote shell login 
capability) access to voyager. This can be verified with the system administrator. If 
that is not the problem, access the boot procedure via the serial connection (kermit). 
The documentation for the boot procedure is contained in the VxWorks Reference 
Guide. 

3. The system should now be up and running. Provided the D/A hookup is connected 
and LEDs are visible to the camera, data should be streaming out the port. We can 
now access the ControlShell and the StethoScope applications. 

4. StethoScope: 

The host computer must be a Sun and running OpenWindows. Type scope wfft & 
and a control window should appear on the screen. A status line in the box will let 
you know that the system is connected to wfft. For help on this application, click on 
the Help... icon and an index of man pages will be brought up. To get a Plot 
window, click on the View icon and a plot window will be brought up as well. Within 
the plot window, right-clicking on the Signals arrow will allow you to choose which 
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signals you want to observe. The data from the signals is near real-time and can be 
copied to a MATRIXx format or Matlab format for further analysis. The help pages 
have the procedure for capturing data. 

5. ControlShell: 

To access the ControlShell, from a xterm window, type rlogin wfft, the prompt 
should be 

VxWorks (VisionServer) -> 

Enter the command cs and the prompt will show 

ControlShell -> 

You are now in the ControlShell application. Hit the Enter key and the menu will 
pop up for you.. The primary applets you will be concerned with are the 
PointGrabber, vision, bodymanager, and scope. 

The PointGrabber contains two major commands: a2d and threshold. The 
nominal values for these are 78 and 180, respectively. By varying these values, the 
threshold level for the amount of light (IR) and the maximum level of light to saturate 
the conversion can be optimized. The rule of thumb is to have at least 100 units 
separation and as high a value for the a2d as possible (255 max, recommend no higher 
than 220). 

The vision topic allows user control of the tracked targets. To lose all targets 
enter vL (vision Lose), to load all targets vl -Inn (vision load all no velocities no 
metric units) and to display the targets on the terminal vd (vision display). 
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The bodymanager allow you to maintain the tracking options for bodies. The topic 
of importance is the tolerance. This command enables the user to set the minimum 
tolerance between two targets for identifying bodies. If a target falls out of this range, 
it is assumed to be a separate point target. 

The scope option allows one to clear off the scope Signals board. By using the 
scU (scope Unload) and point commands, the bodies will be the only signals tracked. 


Setup Files 

The following setup files are read in by the VisionServer system upon initialization: 

setup 

# NPGS setup file. 

# 

# This setup file causes the vision system to report the location of bodies 

# defined in dfe/npgs.dfe to be output to the D/A. 

# 

# modification history 

# — 

# RTI,05oct92,sas Written. 

# 

# 

#################################################### 

# Set up the vision system 

# 

menu read setup.vision 

################################################### 

# Read the data flow specification. 

# 

data read dfe/npgs.dfe 
# 

# 

#################################################### 

# Describe the objects 

# 

menu read setup.describe 

#################################################### 

# Set up the execution list 

# 

menu read setup.exe 
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# 

xecute go 
logout 

setup.vision 

#################################################### 

# 

# Set up the vision system (should be the same as pgrabber/setup) 
vision rate 1 

vision Lose 
Frame xecute go 
PointGrabber interruptEnable 

# 

#################################################### 

# 

# Customize it for the ambient conditions 

# 

#Pb 

PointGrabber threshold 0 78 Note: You can set all ControlShell commands you 

PointGrabber a2d 0 180 want in this file. 

PointGrabber PixelSeparation 2.27 
body tolerance 0.003 
body inconsistent 0.011 
vision verbose 0 
# 

# 6Hz observer: 
ox 0.5872 16.1893 
oy 0.5872 16.1893 
ot 0.5872 16.1893 

# 

# 

# Stop VisionServer scope sampling (cuz the controller will do it) 
list disable Frame 5000000 

# 

PointGrabber heights 0 1.924 

PointGrabber correct Note: These are the calibration coefficients 

0 

0.0018 

0.0025 

0.3287 

0.0001 

0.0001 

-0.0025 

- 0.0002 

0.0017 

- 0.0001 

0.6191 

- 0.0000 

0.0000 

0.0028 

0.0019 
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-0.0003 

0.3269 

0.0019 

0.0001 

0.0024 

0.4976 

npgs.dfe 

This file is where you define you bodies and points. 

# npgs.dfe V data flow system description 

# 

# modification history 

# - -- 

# TestObject,05oct92,sas Written. 

# Base,Elbow,and Tip added, 03Nov95,wbh Written. 

# 

# ___ 

# 

attach: npgs 
# 

# Base, body at flexible arm/rigid body interface 
CSMat: BasePos 3 

x m 0 

y m 0 

theta rad 0 

CSMat: BaseVel 3 

x m/sec 0 

y m/sec 0 

theta rad/sec 0 

CSMat: BaseDataAge 1 

age samples 0 

VisionBody: Base BasePos BaseVel BaseDataAge Sample 

# Elbow, body at flexible arm elbow 
CSMat: ElbowPos 3 

x m 0 

y m 0 

theta rad 0 

CSMat: ElbowVel 3 

x m/sec 0 

y m/sec 0 

theta rad/sec 0 

CSMat: ElbowDataAge 1 

age samples 0 

VisionBody: Elbow ElbowPos ElbowVel ElbowDataAge Sample 
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# Tip, body at flexible arm tip 

CSMat: TipPos 3 

x m 0 

y in 0 

theta rad 0 

CSMat: TipVel 3 

x m/sec 0 

y m/sec 0 

theta rad/sec 0 

CSMat: TipDataAge 1 

age samples 0 

VisionBody: Tip TipPos TipVel TipDataAge Sample 


# Because the d2a component checks the sizes, we need a different gain and 

# offset matrix for each size of output matrix => for each type of 

# object... 

# 

# The gains are in bits/meter. Since there are 4096 bits in 20 volts, 

# 204.8 is 1 volt per meter. Different gains may be desired for 

# velocities, etc. Change them here. 

# 

CSMat: BodyD2AGains 3 

x bits/m 20480 Note: (xlOO) 

y bits/m 20480 (xlOO) 

theta bits/m 2048 (xlO) 

CSMat: BodyD2AOffsets 3 
x bits 0 

y bits 0 

theta bits 0 


CSMat: ElbowD2AOffsets 3 

x bits -11469 

y bits -6779 

theta bits 0 

CSMat: TipD2AOffsets 3 

x bits -4670 

y bits -18186 

theta bits 0 

CSMat: BaseD2AGains 1 

theta bits/m 2048 

CSMat: BaseD2AOffsets 1 
theta bits 0 


Note: Specific for this thesis, this is 
the offset to minimize the rest position 
output on the D/A 


# 
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# Instance the D2A drivers. Each matrix can be output individually. 

# 

vmic4120: Elbowd2a ElbowPos BodyD2AGains ElbowD2AOffsets 0 OXOOcObOOO Sample 
vmic4120: Tipd2a TipPos BodyD2AGains TipD2AOffsets 3 OXOOcObOOO Sample 
vmic4120: Based2a BasePos BodyD2AGains BodyD2AOffsets 6 OXOOcObOOO Sample 


setup.describe 

#################################################### 

# 

# Describe the objects 

# 

# Descriptions of bodies have the form: 

# 

# body describe 

# <name> 

# target locations (3 xy pairs) 

# target height 

# number of ports (A port is any location of interest on the body; normally 0) 

# port locations (omit if 0 ports) 

# tracking divisor (usually 1) 

# mass & inertia (ignore, usually 0) 

# 


body describe 

Base 


0.0 

0.0 

-0.06 

0.015 

-0.06 

0.044 

0 

1 

0.0 0.0 

# 

0.0 

body describe 

Elbow 


0.021 

-0.021 

0.007 

0.013 

-0.015 

0.037 

0 

1 

0.0 0.0 
# 

0.0 

body describe 

Tip 


0.0 

-0.03 

0.014 

0.0265 

-0.03 

0.0 

0.037 



0 

1 
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0.0 0.0 

# 


setup.exe 

#################################################### 

# 

# Set up the execution list 

# 

dynlist select Elbow 
dynlist select Tip 
dynlist select Base 
dynlist save npgs 
dynlist activate npgs 
# 

observer select Null 
# 

matrix install byname EibowPos 
matrix install byname ElbowVel 
matrix install byname TipPos 
matrix install byname TipVel 
matrix install byname BasePos 
matrix install byname BaseVel 
# 

These files are setup for this experiment. They provide a good reference for other 
experiments as well. 

There are also reference manuals for the system contained at the laboratory. 

The points of contact for the VisionServer system are: 

Dr. Stan Schneider and Vince Chen at Real-Time Innovations, Inc . 

Tel: (408) 720-8312 
Fax: (408) 720-8419 
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APPENDIX B 


SYSTEM MATRICES 

A (Plant matrix) 24x24 


A Columns 1 through 6: 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-2.623 8e+008 

-5.3179e+006 

2.7380e+008 

-3.5486e+006 

5.3055e+003 

-1,7665e+004 

-2.7532e+010 

-7.0657e+008 

3.059 le+010 

-3.6131e+008 

5.0245e+005 

-1,6725e+006 

1,7690e+008 

3.0392e+006 

-1.8142e+008 

2.6457e+006 

-2.0354e+004 

6.5544e+004 

-2.3050e+009 

-3.8924e+007 

2.3622e+009 

-3.5089e+007 

4.7656e+005 

-1.8992e+006 

-2.6089e+005 

-4.2462e+003 

2.6687e+005 

-4.1274e+003 

1.8386e+002 

-1.8304e+003 

-7.1923e+008 

-1.1848e+007 

7.3624e+008 

-1.1231e+007 

2.9950e+005 

-1.691 le+006 

5.4046e+004 

8.9028e+002 

-5.5325e+004 

8.4392e+002 

-2.2506e+001 

-1.5015e+005 

-5.0110e+008 

-8.2544e+006 

5.1295e+008 

-7.8246e+006 

2.0867e+005 

-6.548 le+007 

4.9317e+005 

8.1238e+003 

-5.0484e+005 

7.7008e+003 

-2.0537e+002 

8.6270e+004 

-6.5013e+006 

-1.0709e+005 

6.655 le+006 

-1.0152e+005 

2.7073e+003 

-1.1378e+006 

-1.4933e+003 

-2.4599e+001 

1.5286e+003 

-2.3318e+001 

6.2184e-001 

-2.6160e+002 

-1.9714e+006 

-3.2475e-f004 

2.018 le+006 

-3.0783e+004 

8.2094e+002 

-3.4524e+005 
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A Columns 7 through 12: 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-6.1947e+005 

-3.5516e+004 

1.0644e+OO6 

-1.1069c+004 

1.5520e+001 

-3.2960e+000 

-5.8648e+007 

- .— —. mm*, m . .. 

-3.3625e+006 

1,0077e+008 

-1.0479e+006 

1.4694e+003 

-3.1204e+002 

2.2958e+006 

1.3162e+005 

-3.9448e+006 

4.1021e+004 

-5.7519e+001 

1.2215e+001 

-6.6970e+007 

-3.8395e+006 

1.1507e+008 

-1.1966e+006 

1.6779e+003 

-3.5632e+002 

-6.6409e+004 

-3.8074e+003 

1.141 le+005 

-1.1866e+003 

1,6638e+000 

-3.5333e-001 

-6.0350e+007 

-3.4600e+006 

1.0370e+008 

-1.0783e+006 

1.5120e+003 

-3.2110e+002 

-2.6370e+008 

-5.3393e+006 

2.7515c+008 

-3.5694e+006 

6.085 le+003 

-1.2929e+003 

-2.7699e+010 

-7.1104e+008 

3.0792e+010 

-3.6404e+008 

5.773 le+005 

-1.2264e+005 

l.8176e+008 

3.1203e+006 

-1.8642e+008 

2.7222e+006 

-2.3198C+004 

4.8401 e+003 

-2.4629e+009 

-4.1529e+007 

2.5240e+009 

-3.7573e+007 

5.6752e+005 

-1.3300e+005 | 

-6.000 le+ 

-9.7415e+003 

6.1374e+005 

-9.5233e+003 

4.6746e+002 

-1.5088e+002 

-7.7718e+008 

-1.2772e+007 

7.9556e+008 

-1.2173e+007 

3.6121e+005 

-9.7577e+004 


A Columns 13 through 18: _ __ 

1 _0_0_0_ 0 1 ~Q 

o _I_0_0_0_0 

0 _0_I_0_0_0 

o _0_0_I_0_0 

0 _0_0_0_1_0 

0 _0_0_0_0_ ]_ 

_o_0_0 0 0 0 


0 

0 

0 

■ 0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

-2.048 le+003 

-2.7550e+001 

1.7773e+003 

-1.9274e+001 

2.0718e-001 

2.5214e-001 

-1.2644e+005 

-4.7556e+003 

1.5563e+005 

-1.364 le+003 

1.3108c+001 

-2.792 le+000 

1.3917e+003 

1.2529e+001 

-1.4958e+003 

3.1263e+001 

9.4949e-001 

-2.1226e-001 

-1.790le+004 

-1.5648e+002 

1.9060e+004 

-4.8544e+002 

5.7886e+001 

-8.8929e+001 

-1.927 le+000 

-I.6223e-002 

2.1141c+000 

-1.3180e-002 

-1.5200e-002 

-2.1869e-001 

-5.4637e+003 

-4.5895e+001 

5.7527e+003 

-1.5984e+002 

6.5974e+001 

-1.5636e+002 

2.9835e+000 

6.7566e-002 

1.8467e+000 

-1.0543e+000 

2.1907e+000 

8.8401 e+000 

-1.655 le+003 

-2.5068e+001 

1.5926e+003 

-2.3864e+001 

1.5078e+001 

-6.1425e+002 

-6.5206e-002 

1.4592e-002 

2.7265e+000 

-9.8728e-001 

2.5252e+000 

4.2233e+000 

1.1009e+001 

-2.1449e-001 

-6.9045e+001 

4.3647e+000 

8.6069e+000 

-4.0245e+001 

5.6003e-003 

-5.636 le-005 

-1.3079e-002 

2.2613e-004 

-7.8583e-002 

-7.642 le-003 
























































































































































































































































































7.3721 e+000 

-7.3807e-002 

-2.0839e+001 

-3.7006e-001 

-2.4475e+000 

-8.5091 e+000 


A Columns 19 


0 


0 


0 


0 


0 


0 


through 24: 


0 


0 


0 


0 


0 


0 





-1.1086C+001 

1.0002e-001 

2.7043e+000 

8.1490e-002 

1,9356e-002 

-1.1224e-002 

-3.485 le+002 

1.671 lc+000 

2.1629e+002 

4.0357e-001 

2.5826e-001 

-2.5936e-001 

-3.0106e+000 

7.1221e-001 

-7.9965e+000 

2.5647e-001 

1,9990e-002 

-1.8806e-002 

7.6339e+002 

-2.9170e+001 

5.367 le+002 

-2.3678e+000 

-2.9142e-001 

-2.2942e-001 

1.4315e+000 

-3.6204e-002 

1,0940e+000 

2.1656e-002 

3.9756e-002 

-1.1246e-002 

1,0878e+003 

-3.083 le+001 

7.4429e+002 

6.4553e+000 

1.7155e+001 

-3.2682e+000 

-2.0338e+003 

-2.7639e+001 

1.7853e+003 

-1.8738e+001 

1.3150e+000 

-2.7654e-001 

-1.2653e+005 

-4.7656e+003 

1.5582e+005 

-1.3637e+003 

2.9535e+001 

-6.6973e+000 

1,4266e+003 

1.2753e+001 

-1.5089e+003 

3.1997e+001 

2.6114e+000 

-5.7461 e-001 

-1.9060e+004 

-1.6548e+002 

2.0214e+004 

-5.1969e+002 

8.1755e+001 

-1.8505e+001 

-4.5431 e+000 

-3.6568e-002 

4.9598e+000 

-1.2535e-001 

1.9969e-001 

-1.1468e-001 

-5.9097e+003 

-4.8940e+001 

6.2656e+003 

-1.9339e+002 

1,2829e+002 

-4.4148e+001 



B (Control Matrix) 24x2 


5-0424e+000 
8.6320e+002 
-1.5264e+000 
1,9386e+001 
2.0756e-003 
5.8274C+000 
-4.3790e-004 
4.0600c+000 
-3.9958e-003 


-I.8668C-002 
-l.7673e+000 
6.9184e-002 
-2.0181 e+000 
-2.0012e-003 
-1.8186e+000 
5.0531 e+000 
8.6294e+002 
-1.5637e+000 
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5.2675e-002 

2.0630e+001 

1.2099e-005 

4.7471e-003 

1.5973e-002 

6.2633e+000 


C (Observation Matrix) 6x24 


C Columns 1 through 6: 



0 

1.0938e+004 

0 

-1.0938e+004 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 



C Columns 7 through 12: 



0 

0 

0 

0 

0 

1,0938e+004 

0 

-1.0938e+004 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 



C Columns 13 through 24: 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 ! 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 


















































































































































































































































FINITE ELEMENT MODEL MATLAB CODE 

%%Finite EleMent Model PrograM for the FSS 

%% 

%%This prograM characterizes the FSS flexible appendage. 

%%LCDR Bill Harrington, USN October 1995 

%% 

%%The flexible appendage is to be Modeled as a 6 eleMent FEM with 
%%piezoceraMic actuators located on eleMents 1 and 4, and piezoceraMic 
%%sensors located on eleMents 2 and 5. The elbow and tip will be treated as 
%%rigid body Masses. 

%% 

%% 

%%This Model assuMes 0.5% structural daMping, and will solve for the first 
%%12 natural Modes. The degree of accuracy is suitable only for the 
%%first 3 Modes (half the nuMber of eleMents, normally). 

%% 

clear 
clc 

format short e 
global A B C D 

%%structural properties 

nuMeleMents=6; 

h=[0.07 0.03 0.5688 0.07 0.03 0.549]; 
thicKness=0.0015875; 
height=0.0254; 
rho=2800; 

elMass=rho*height*thicKness; 
elinertia=l/12*lhicKness A 3*height; 

E=72e9; 

%%CoMpute eleMental stiffness and Mass Matrices 

KeleMent=0*ones(4,4*nuMelcMents); 

MeleMent=0*ones(4,4*nuMeleMents); 

for i=l :nuMeleMents,... 

KcleMent(:,4*i-3:4*i)=E*elinertia/h(i) A 3*[12 6*h(i) -12 6*h(i);... 
6*h(i) 4*h(i) A 2 -6*h(i) 2*h(i) A 2;-12 -6*h(i) 12 -6*h(i);... 

6*h(i) 2*h(i) A 2 -6*h(i) 4*h(i) A 2]; 

end 

for i=l :nuMeleMents,... 

MeleMent(:,4*i-3:4*i)=elMass*h(i)/420*[156 22*h(i) 54 -13*h(i);... 
22*h(i) 4*h(i) A 2 13*h(i) -3*h(i) A 2;54 13*h(i) 156 -22*h(i);... 


%%Meters 


%%Kg/M A 3 

%%Mass/length 

%%Meter A 4 

%%Modulus of elasticity 




-13*h(i) -3*h(i) A 2 -22*h(i) 4*h(i) A 2]; 

end 

%%C onstruct global Mass and stiffness Matrices 

M=0*ones(2*(nuMeleMents+l)); 

K=0*ones(2*(nuMeleMents+l)); 

for i=l :nuMeleMents,... 

M(2*i-1:2*i+2,2*i-l :2*i+2)=M(2*i-l :2*i+2,2*i-l:2*i+2) + MeleMent(:,4*i-3:4*i); 
end 

for i=l :nuMeleMents,... 

K(2*i~l :2*i+2,2*i-l :2*i+2)=K(2*i-l :2*i+2,2*i-l :2*i+2) + KeleMent(:,4*i-3:4*i); 
end 

%%Clean up 
clear elinertia; 

%%Fix for fixed boundry condilion (ro\v,coluMns 1 &2 =0) 

M=M(3:2*(nuMeleMents+l ),3:2*(nuMeleMents+l)); 

K=K(3:2*(nuMeleMents+1 ),3:2*(nuMeleMents+l)); 

M(5,5:8)=M(5,5:8)-MeleMent( 1,13:16); 

M(6:8,5)=M(6:8,5)-MeleMent(2:4,l 3); 

K(5,5:8)=K(5,5:8)-KeleMent( 1,13:16); 

K(6:8,5)=K(6:8,5)-KeleMcnt(2:4,13); 


clear KeleMent MeleMent; 

%%Now add elbow and tip Masses. 

Mel bow=0.40823; 

Mtip=0.37648; 

MbeaM2=(h(l)+h(2)+h(3))*clMass; 

M(5,5)=M(5,5)+MeIbow+MbeaM2+Mtip; 

M( 11,11 )=M(11,11)+Mlip; 

clear Mpoint Melbow Mtip ipoint MbeaM2; 

%%Define the piezo actuator and sensor eleMents 

delta=thicKness/2; 

tp=2*1.905e-4; 

wp=0.02; 

Ep=6.3el0; 
d31=-l .8e-10; 
eT3=l .5e-8; 
rhop=7700; 

Kpiezo=wp*tp*Ep*(dclta A 2 + delta*tp + (tp A 2)/3); 
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Ka=Kpiezo/h(l)*[12/h(l) A 2 6/h(l) -12/h(1) A 2 6/h(l);... 

6/h( 1) 4 -6/h(l) 2;-12/h(1) A 2 -6/h(l) 12/h(1) A 2 -6/h(l);... 

6/h(l) 2 -6/h(l)4]; 

Ks=Kpiezo/h(2)*[l2/h(2) A 2 6/h(2) -12/h(2) A 2 6/h(2);... 

6/h(2) 4 -6/h(2) 2;-12/h(2) A 2 -6/h(2) 12/h(2) A 2 -6/h(2);... 

6/h(2) 2 -6/h(2) 4]; 

Mp=rhop*wp*tp; %%Mass/length piezo 

Ma=Mp*h( 1 )/420*[ 156 22*h(l) 54 -13*h(l);22*h(l) 4*h(l) A 2 13*h(l) -3*h(l) A 2;... 
54 13*h(1) 156 -22*h(1);-13*h(l) -3*h(l) A 2 -22*h(l) 4*h(1) A 2]; 

Ms=Mp*h(2)/420*[156 22*h(2) 54 -13*h(2);22*h(2) 4*h(2) A 2 13*h(2) -3*h(2) A 2;... 
54 13*h(2) 156 -22*h(2);-13*h(2) -3*h(2) A 2 -22*h(2) 4*h(2) A 2]; 

%%Add the piezo eleMent Mass and stiffness Matrices to the structure 

M(1:2,1:2)=M( 1:2,1:2)+2*Ma(3:4,3:4); 

M( 1:4,1:4)=M( 1:4,1:4)+2*Ms; 

M(6:8,6:8)=M(6:8,6:8)+2*Ma(2:4,2:4); 

M(7:10,7:10)=M(7:10,7:10)+2*Ms; 

K(1:2,1:2)=K( 1:2,1:2)+2*Ka(3:4,3:4); 

K( 1:4,1:4)=K( 1:4,1:4)+2*Ks; 

K(6:8,6:8)=K(6:8,6:8)+2*Ka(2:4,2:4); 

K(7:10,7:10)=K(7:10,7:10)+2*Ks; 

clear Ks Ka Ms Ma Kpiezo; 

%%Solve for natural frequencies and Mode shapes. 

[oMega2,Phi,Psi]=eign(K,M); 

oMega=sqrt(oMega2); 

Hert z=oMega/2/p i; 

ttl=str2mat(’ Omega','Hertz',' '); 

fttl(l,:) ttl(3,:) ttl(2,:)] 

[oMega Hertz] 

%%Construct the a,b,c, and d Matrices for state-space forM. 


%%Need More info on the piezos. 


bbl =0; bb2=-d31 *Ep*wp*(delta +tp/2); bb3=0; bb4=-bb2; 
gaMMa=wp*h(2)/tp*(eT3-d31 A 2*Ep); 
b1=[bb3 bb4000000000 0]; 
b2=[0 0 0 0 bbl bb2 bb3 bb4 0 0 0 0]; 

btMp=[bl' b2']; btMp2=-2*inv(M)*btMp; btMp3=-2*Phi'*btMp; 
ctMp=[bbl bb2bb3 bb4 zeros( 1,20)]/gaMMa; %sensor 1 

ctMp2=[0 0 0 0 0 0 bbl bb2 bb3 bb4 0 0 zeros(l ,12)]/gaMMa; %sensor 2 

clMp3=[00 0 0 1 0zeros(l,18)]; %e. disp. 

ctMp4=[0 0 0 0 0-1 zerosfl ,18)]; %e. rot. 

ctMp5=[zeros(l,10) 1 0 zeros(l,12)]; %t. disp. 

ctMp6=[zeros(l,10) 0-1 zcros(l,12)]; %t. rot. 
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a=[0*ones(12) eye(12);-inv(M)*K 0*ones(12)]; 
b=[0*ones(12,2);btMp2]; 

c=[ctMp;ctMp2;ctMp3;ctMp4;ctMp5;ctMp6]; %observation matrix 

d=0*ones(6,2); 

clear bbl bb2 bb3 bb4 gaMMa bl b2 btMp ctMp; 
clear ctMp2 ctMp3 ctMp4 ctMp5 ctMp6 ctMp7 ctMp8; 
clear E Ep eT3 i; 

clear btMp2 cx d31 delta e elMass ep et3 height Mp rho rhop; 
clear thicKness tp wp 

%%Construct transformation matrix from modal to physical coordinates. 

PhiJnv=inv(Phi); 

PPhi=zeros(24); 

PPhi(l: 12,1:12)=Phi Jnv; 

PPhi(l 3:24,13:24)=Phi_inv; 

PPhiJnv=inv(PPhi); 

%%Insert natural structural damping, 0.5% for first two modes then 20% for rest. 

damp=-2*0.005*oMega(l :2);damp2=-2*0.1 *oMega(3:12); damp3=diag([damp' damp2’]); 
a2=[zeros(l 2) eye(l 2);-diag(oMega2) damp3]; 
b2=fzeros(l 2,2);btMp3]; 

c2=[c(:,l :12) zeros(6,l 2)]*[Phi zeros(size(Phi));zeros(size(Phi)) Phi]; 
d2=d; 

a2m=PPhi_inv*a2*PPhi; 

A=clean(a2m,le-6); 

b2m=PPhi_inv*b2; 

B=clean(b2m, 1 e-6); 
c2m=c2*PPhi; 

C=cIean(c2m,le-7); 

D=d; 

%%Set an initial condition (tip displaced by 3 cm) 
x0=[0 0 0 0 0.02 0 0 0 0 0 -0.03 0 zeros(1,12)]; 

%%Time vector, t 
t=0:0.01:30; 

dispCInitialization of variables complete for two beam analysis. (FEM3)') 
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